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ATTITUDE SENSING SYSTEM FOR AN 
AUTOMOTIVE VEHICLE RELATIVE TO THE ROAD 

Technical Field 

[0001] The present invention relates generally to a 
control apparatus for controlling a system of an 
automotive vehicle in response to sensed dynamic 
behavior, and more specifically, to a method and 
apparatus for controlling the system of the vehicle by 
determining attitude of the vehicle. 

Background 

[0002] Dynamic control systems for automotive 
vehicles have recently begun to be offered on various 
products. Dynamic control systems typically control the 
yaw of the vehicle by controlling the braking effort at 
the various wheels of the vehicle. Yaw control systems 
typically compare the desired direction of the vehicle 
based upon the steering wheel angle and the direction of 
travel. By regulating the amount of braking at each 
corner of the vehicle, the desired direction of travel 
may be maintained. Typically, the dynamic control 
systems do not address roll of the vehicle. For high 
profile vehicles in particular, it would be desirable to 
control the rollover characteristic of the vehicle to 
maintain the vehicle position with respect to the road. 
That is, it is desirable to maintain contact of each of 
the four tires of the vehicle on the road. 
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[0003] In vehicle rollover control, it is desired to 
alter the vehicle attitude such that its motion along 
the roll direction is prevented from achieving a 
predetermined limit (rollover limit) with the aid of the 
actuation from the available active systems such as 
controllable brake system, steering system and 
suspension system. Although the vehicle attitude is 
well defined, direct measurement is usually impossible. 

[0004] There are two types of vehicle attitudes 
needed to be distinguished. One is the so-called global 
attitude, which is sensed by the angular rate sensors. 
The other is the relative attitude, which measures the 
relative angular positions of the vehicle with respect 
to the road surface on which the vehicle is driven. The 
global attitude of the vehicle is relative to an earth 
frame (or called the inertia frame), sea level, or a 
flat road. It can be directly related to the three 
angular rate gyro sensors. While the relative attitude 
of the vehicle measures the relative angular positions 
of the vehicle with respect to the road surface, which 
are always of various terrains. Unlike the global 
attitude, there are no gyro- type sensors which can be 
directly related to the relative attitude. A reasonable 
estimate is that a successful relative attitude sensing 
system must utilize both the gyro- type sensors (when the 
road becomes flat, the relative attitude sensing system 
recovers the global attitude) and some other sensor 
signals . 

[0005] One reason to distinguish relative and global 
attitude is due to the fact that vehicles are usually 
driven on a 3 -dimensional road surface of different 



2 

3 



terrains, not always on a flat road surface. Driving on 
a road surface with large road^ bank does increase the 
rollover tendency, i.e., a large output from the global 
attitude sensing system might well imply an 
uncontrollable rollover event regardless of the flat 
road driving and the 3-D road driving. However driving 
on a three-dimensional road with moderate road bank 
angle, the global attitude may not be able to provide 
enough fidelity for a rollover event to be 
distinguished. Vehicular rollover happens when one side 
of the vehicle is lifted from the road surface with a 
long duration of time without returning back. If a 
vehicle is driven on a banked road, the global attitude 
sensing system will pick up certain attitude information 
even when the vehicle does not experience any wheel 
lifting (four wheels are always contacting the road 
surface) . Hence a measure of the relative angular 
positions of the vehicle with respect to the portion of 
the road surface on which the vehicle is driven provides 
more fidelity than global attitude to sense the rollover 
event . 

[0006] The vehicle rollover sensing system used for 
deploying safety-related devices has been proposed in 
US 6,002,975, US 6,038,495, EP 1002709A2, where a stand- 
alone sensor module including 5 sensors are used 
including the roll/pitch angular rate sensors, 
later/longitudinal/vertical acceleration sensors. These 
systems sense the global attitude of a vehicle without 
considering the relative attitude of the vehicle with 
respect to the road surfaces. Due to the stand-alone 
nature of the sensing module, it does not share internal 
information with vehicle dynamics control systems. 



[0007] The rollover control system using brake 
controls has been proposed in US 6,065,558 ("Anti- 
Rollover Brake System"), where the claimed sensor 
setting could be any of the following: (1) a lateral 
accelerometer ; (2) a sensor for measuring the body roll 
angle; (3) an accelerometer, a gyroscope, a roll rate 
senor, and sensors measuring the distances between the 
vehicle and the wheels to measure the roll angle of the 
vehicle. In the current invention, a different sensor 
set is used. The used sensors includes those used in 
the vehicle yaw stability control (lateral/longitudinal 
accelerometers , yaw angular rate sensor, wheel speeds 
and steering angle) and an extra roll rate angular 
sensor. Also, notice that US 6,065,558 does not intend 
to distinguish between global and relative attitude of a 
vehicle reflected by the Euler angles. 

[0008] Another vehicle attitude sensing method has 
been proposed in US 5,408,411 ("System For Predicting 
Behavior Of Automotive Vehicle And For Controlling 
Vehicular Behavior Based Thereon"). Where a sensor 
module using six linear accelerations is mounted on the 
vehicle to get vehicular attitude information. 

[0009] It would therefore be desirable to provide an 
attitude control system to predict attitude angle for 
vehicle dynamics control that includes the 
inter dependency among the roll, pitch and yaw motions 
while compensating for long term maneuvers. 

Summary of the Invention 

[0010] The present invention aims to estimate and 
predict the vehicular attitude used in a rollover 



control system which can prevent the vehicle from 
rolling over. • The estimated and predicted variables are 
used for setting a rollover control action flag and as 
the feedback signals to construct the desired control 
forces for controlling roll stability or activate other 
safety devices. In detail, the rollover control action 
needs the information from the vehicle attitude sensing 
system, the available sensors, and the driving/road 
condition identifiers. The rollover control flag is set 
based on a rollover logic process. In case a positive 
determination of vehicle rollover is deemed from this 
rollover logic process, the control commands will be 
computed by feeding back the estimated vehicle attitude 
variables. The control command output is further sent 
to the ECU of the hardware to activate the system. In 
detail, the vehicle attitude sensing system uses all the 
sensors available for yaw stability control (including a 
later accelerometer , a longitudinal accelerometer, a yaw 
angular rate, a steering angle sensor and the wheel 
speed sensor signals) together with a roll angular rate 
sensor. The vehicle attitude is characterized by the 
relative Euler angles of the car body with respect to 
the road surface and by the global Euler angles of the 
car body with respect to the sea level. The vehicle 
attitude estimation and prediction utilize both the 
kinematic and the dynamic relationships derived from 
vehicle dynamics and vehicle dynamic models to relate 
the desired motion variables with the measured sensor 
signals . 

[0011] In one aspect of the invention, a stability 
control system for an automotive vehicle includes a 
plurality of sensors sensing the dynamic conditions of 
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the vehicle. The sensors may include a speed sensor, a 
lateral acceleration sensor, a roll rate sensor, a yaw 
rate sensor and a longitudinal acceleration sensor. The 
controller is coupled to the speed sensor, the lateral 
acceleration sensor, the roll rate sensor, the yaw rate 
sensor and a longitudinal acceleration sensor. The 
controller determines a global roll attitude and a 
global pitch attitude from the roll rate, lateral 
acceleration signal and the longitudinal acceleration 
signal. The controller determines a roll gradient based 
upon a past raw roll rate and current raw roll rate, the 
roll angular rate signal and the lateral acceleration 
signal, a pitch gradient based upon a past raw pitch 
rate and current raw pitch rate the calculated pitch 
angular rate signal and the longitudinal acceleration 
signal. The controller determines a relative roll and 
relative pitch as a function of the roll gradient and 
the pitch gradient - 

[0012] In a further aspect of the invention, a method 
of controlling roll stability of the vehicle comprises 
the steps of: 

measuring a roll rate of the vehicle body; 

measuring a lateral acceleration of the 
vehicle body; 

measuring the longitudinal acceleration of the 
vehicle body; 

measuring the yaw rate of the vehicle body; 

and 

determining relative roll angle, the relative 
pitch angle, the global roll and global pitch angle in 
response to the roll rate, the yaw rate, the lateral 
acceleration and the longitudinal acceleration. 
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[0013] Reducing system cost is typically a goal in 
automotive systems. Since one of the three angular rate 
signals (pitch rate signal) can be predicted from the 
other available signals, the cost reduction of the 
system is possible by eliminating a pitch rate sensor. 
Also, vertical acceleration sensor may be eliminated to 
further reduce cost . 

[0014] Other advantages and features of the present 
invention will become apparent when viewed in light of 
the detailed description of the preferred embodiment 
when taken in conjunction with the attached drawings and 
appended claims. 

Brief Description Of The Drawings 

[0015] Figure 1 is a diagrammatic view of a vehicle 
with variable vectors and coordinator frames according 
to the present invention. 

[0016] Figure 2 is a block diagram of a stability 
system according to the present invention. 

[0017] Figure 3 is a diagrammatic view showing the 
displacement (relative to road surface) of the four 
corners of the vehicle body along the body-fixed 
vertical axis. 

[0018] Figure 4 is a diagrammatic view showing the 
two components of the relative corner displacement 
depicted in Figure 3 . 

[0019] Figure 5 is flow chart of determination 
according to the present invention. 
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Description 0£ The Preferred Embodiment 

[0020] In the following figures the same reference 
numerals will be used to identify the same components. 
The present invention is preferably used in conjunction 
with a rollover control system for a vehicle. However, 
the present invention may also be used with a deployment 
device such as airbag or roll bar. The present 
invention will be discussed below in terms of preferred 
embodiments relating to an automotive vehicle moving in 
a three-dimensional road terrain. 

[0021] Referring to Figure 1, an automotive vehicle 
10 with a safety system of the present invention is 
illustrated with the various forces and moments thereon 
during a rollover condition. Vehicle 10 has front right 
and front left tires 12a and 12b and rear right tires 
13a and left rear tires 13b respectively. The vehicle 
10 may also have a number of different types of front 
steering systems 14a and rear steering systems 14b 
including having each of the front and rear wheels 
configured with a respective controllable actuator, the 
front and rear wheels having a conventional type system 
in which both of the front wheels are controlled 
together and both of the rear wheels are controlled 
together, a system having conventional front steering 
and independently controllable rear steering for each of 
the wheels or vice versa. Generally, the vehicle has a 
weight represented as Mg at the center of gravity of the 
vehicle, where g=9,Zmls^ and M is the total mass of the 

vehicle . 

[0022] As mentioned above, the system may also be 
used with active/semi-active suspension systems, anti- 



8 



V 



roll bar or other safety devices deployed or activated 
upon sensing predetermined dynamic conditions of the 
vehicle . 

[0023] The sensing system 16 is coupled to a control 
system 18. The sensing system 16 preferably uses a 
standard yaw stability control sensor set (including 
lateral accelerometer , yaw rate sensor, steering angle 
sensor and wheel speed sensor) together with a roll rate 
sensor and a longitudinal accelerometer . The various 
sensors will be further described below. The wheel 
speed sensors 20 are mounted at each corner of the 
vehicle, and the rest of the sensors of sensing system 
16 are preferably mounted directly on the center of 
gravity of the vehicle body, along the directions x,y and 
z shown in Figure 1. As those skilled in the art will 
recognize, the frame from b^, and is called a body 

frame 22, whose origin is located at the center of 
gravity of the car body, with the b^ corresponding to the 
X axis pointing forward, b^ corresponding to the y axis 
pointing off the driving side (to the left) , and the by 
corresponding to the z axis pointing upward. The 
angular rates of the car body are denoted about their 
respective axes as for the roll rate, Wy for the 

pitch rate and for the yaw rate. The present 

invention calculations preferably take place in an 
inert ial frame 24 that may be derived from the body 
frame 22 as described below. 

[0024] The angular rate sensors and the 
accelerometers are mounted on the vehicle car body along 
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the body frame directions b^, and b^ , which are the 
X- y- I axes of the vehicle's sprung mass. 

[0025] The longitudinal acceleration sensor is 
mounted on the car body located at the center of 
gravity, with its sensing direction along 6,-axis, whose 

output is denoted as a, . The lateral acceleration sensor 
is mounted on the car body located at the center of 
gravity, with its sensing direction along ^^-axis, whose 
output is denoted as Oy . 

[0026] The other frame used in the following 
discussion includes the road frame, as depicted in 
Figure 1. The road frame system r^^r^ is fixed on the 
driven road surface, where the axis is along the 
average road normal direction computed from the normal 
directions of the four tire/road contact patches. 

[0027] In the following discussion, the Euler angles 
of the body frame bpj^^ with respect to the road frame 
r/^r^ are denoted as q^i^^ qyi^^ and q^^ , which are also called 

the relative Euler angles. 

[0028] The present invention estimates the relative 
Euler angles q^^ and q^^ based on the available sensor 

signals and the signals calculated form the measured 
values . 

[0029] Referring now to Figure 2, roll stability 
control system 18 is illustrated in further detail 
having a controller 26 used for receiving information 
from a number of sensors which may include a yaw rate 
sensor 28, a speed sensor 20, a lateral acceleration 
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sensor 32, a roll rate sensor 34, a steering angle 
sensor 35, a longitudinal acceleration sensor 36, a 
pitch rate sensor 37 and steering angle position sensor 
39. 

[0030] In the preferred embodiment only two axial 

rate sensors are used. When two of these axial rates 
are known, the other may be derived using other commonly 
available sensors. 

[0031] That is, pitch rate sensor 37 is illustrated, 
it can be eliminated in the preferred embodiment. 

[0032] In the preferred embodiment the sensors are 
located at the center of gravity of the vehicle. Those 
skilled in the art will recognize that the sensor may 
also be located off the center of gravity and translated 
equivalently thereto. 

[0033] Lateral acceleration, roll orientation and 
speed may be obtained using a global positioning system 

(GPS) . Based upon inputs from the sensors, controller 
26 may control a safety device 38. Depending on the 
desired sensitivity of the system and various other 
factors, not all the sensors 28-37 may be used in a 
commercial embodiment. Safety device 38 may control an 
airbag 4 0 or a steering actuator or braking actuator at 
one or more of the wheels 41, 42, 44, 46 of the vehicle. 
Also, other vehicle components such as a suspension 
control 48 may be used to adjust the suspension to 
prevent rol lover . 

[0034] Roll rate sensor 34 and pitch rate sensor 37 
may sense the roll condition of the vehicle based on 
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sensing the height of one or more points on the vehicle 
relative to the road surface. Sensors that may be used 
to achieve this include a radar-based proximity sensor, 
a laser-based proximity sensor and a sonar-based 
proximity sensor. 

[0035] Roll rate sensor 34 and pitch rate sensor 37 
may also sense the roll condition based on sensing the 
linear or rotational relative displacement or 
displacement velocity of one or more of the suspension 
chassis components which may include a linear height or 
travel sensor, a rotary height or travel sensor, a wheel 
speed sensor used to look for a change in velocity, a 
steering wheel position sensor, a steering wheel 
velocity sensor and a driver heading command input from 
an electronic component that may include steer by wire 
using a hand wheel or joy stick. 

[0036] The roll condition may also be sensed by 
sensing the force or torque associated with the loading 
condition of one or more suspension or chassis 
components including a pressure transducer in an act of 
air suspension, a shock absorber sensor such as a load 
cell, a strain gauge, the steering system absolute or 
relative motor load, the steering system pressure of the 
hydraulic lines, a tire laterally force sensor or 
sensors, a longitudinal tire force sensor, a vertical 
tire force sensor or a tire sidewall torsion sensor. 

[0037] The roll condition of the vehicle may also be 
established by one or more of the following 
translational or rotational positions, velocities or 
accelerations of the vehicle including a roll gyro, the 
roll rate sensor 34, the yaw rate sensor 28, the lateral 
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acceleration sensor 32, a vertical acceleration sensor, 
a vehicle longitudinal acceleration sensor, lateral or 
vertical speed sensor including a wheel -based speed 
sensor, a radar-based speed sensor, a sonar-based speed 
sensor, a laser-based speed sensor or an optical-based 
speed sensor. 

[0038] Steering control 38 may control the position 
of the front right wheel actuator 40, the front left 
wheel actuator 42, the rear left wheel actuator 44, and 
the right rear wheel actuator 46. Although as described 
above, two or more of the actuators may be 
simultaneously controlled. For example, in a rack-and- 
pinion system, the two wheels coupled thereto are 
simultaneously controlled. Based on the inputs from 
sensors 28 through 39, controller 26 determines a roll 
condition and controls the steering position of the 
wheels . 

[0039] Speed sensor 30 may be one of a variety of 
speed sensors known to those skilled in the art. For 
example, a suitable speed sensor may include a sensor at 
every wheel that is averaged by controller 26. 
Preferably, the controller translates the wheel speeds 
into the speed of the vehicle. Yaw rate, steering 
angle, wheel speed and possibly a slip angle estimate at 
each wheel may be translated back to the speed of the 
vehicle at the center of gravity. Various other 
algorithms are known to those skilled in the art. Speed 
may also be obtained from a transmission sensor. For 
example, if speed is determined while speeding up or 
braking around a corner, the lowest or highest wheel 
speed may not be used because of its error. Also, a 
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transmission sensor may be used to determine vehicle 
speed. 

Connecting The Relative Attitudes With The Relative 
Corner Displacements 

[0040] In operation, the method according to the 
present invention first correlates the relative attitude 
with the displacement at each corner of the vehicle. 
Consider a vector with x- y - z coordinates as ;c^,j/^,z^of its 
end point in the body frame of Figure 1 . The z 
coordinator of the end point of the same vector measured 
in the road frame can be computed from the Euler 
transformation 

'Xf^ sm(qy^^ ) + y^^ sm{q^^^ ) cos(^^^^ ) + cos(^^^^ ) cos(9^^^ ) ( 1 ) 

Let / be the half of the wheel track; t^. and be the 

distances from the center of gravity of the car body to 
the front and rear axles; h be the distance between the 
bottom of the vehicle body and the center of gravity of 
the vehicle along the body z -axis; q^^^ and q^^ are the 

relative roll and pitch angles. Then in the body frame 
the four corners of the vehicle body where suspensions 
are connected with the wheel have the following 
coordination: 



LF 


Corner : 


X 




/, 


z == 


- h 


RF 


Corner : 


: X 


= V' y " 




l,z = 


- h 


LR 


Corner ; 


: X 


= -tr,y^ 


/, 


z = 


- h 


RR 


Corner 


: ;c 


= -tr,y = 




hz - 


- h 



(2) 



14 



Let and i^r k>e the relative displacements of the 

vehicle corners at the left- front, right -front, left- 
rear and right -rear locations, which are measured along 
the direction perpendicular to the average road surface. 
By using the transformation in Equation (1) , those 
corner displacements relative to the road surface can be 
expressed as the function of the relative roll and pitch 
angles q^^^ and 

2rr = ^rSin(^^^^)- / Sltl (^^^^ ) COS(^^^^ ) + (z^^ - COS(^^^ ) COS(^^.^ ) 

where z^g is the relative displacement of the center of 
gravity of the vehicle with respect to the road surface, 
but measured along the body z -axis . 

[0041] Referring now to Figure 3, the four equations 
of Equation (3) pose four constraints on a set of seven 
variables : z^pz^^z^^ , z^r , Zcg , ^^^^ and q^^^ . Hence a combination 

of three variables can be used to compute the rest of 
the variables. Since q^^ and ^y^^ are of interest in the 

present invention, the possible choices are choosing 
three variables from z^^z^pz^^ , z,r and z^g to characterize 
q^^^ and qy^^ . The direct measurement of any of z^z^^z^^ , z,, 

and z^g is relatively expensive (for example, expensive 

laser distance sensors can be used) . Hence, measuring 
any three of z^^z^^z^^ , z^r and Zcg may be cost prohibitive in 

a commercial environment with current technology. 
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However, certain linear combinations of the four corner 
displacements z^pz^^z^^ and Zrr can be related to the 

available sensors through dynamics. When linear 

combinations are related to the relative roll and pitch 
Euler angles q^^ and q^^ , and q^^ may be characterized 

from the available sensor signals. In the following, 
the effort has been focused on finding those linear 
combinations of ^ip^rp^i^ / ^rr > which bridges between q^^^ and 

q^^ , and the available sensor signals including the 

lateral and longitudinal accelerations, the roll and yaw 
angular rates and the wheel speed sensor signals. 

The Relative Attitudes Based On The Linear Combinations 
Of The Corner Displacements 

[0042] The linear combinations of z^z^pz^^ , z^r , which 
serve as bridges to connect q^^ and q^^ with the 

available sensor signals are the following variables, 
which are called the relative roll and pitch gradients 



4/ 



(4) 



Q, and Q^, is related to the relative roll and pitch 
attitudes by manipulating the equations in (3) . The 
final formula for the relative pitch Euler angle is 

q^^ = sin-»{Q^} (5) 
and the final formula for the relative roll Euler angle 
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(6) 



[0043] On the other hand and can be further 

related to the available sensor signals through dynamic 
equations which describe the vehicle body dynamics. Q,^ 
and will be first broken into two portions, and 

related to the sensor signals. 

Roll And Pitch Gradients Due To Suspension And Wheel 

Motions 

[0044] As shown in Figure 4, a portion of the left 
front wheel 12b and suspension 52 are illustrated, z,^ 

can be further expressed as the sum of the two parts: 
the suspension stroke as measured by sensor 50 and the 

wheel displacement iv^^with respect to the road surface 

along the direction perpendicular to the road surface. 
The same is true for the rest of the corner locations. 
The sensor 50 may measures the change in the distance 
from the vehicle body to the wheel. If the four 
suspension strokes are s^pS^pS^^axid , and the four wheel 

vertical motions are i^'W .,vv,^and w^r , then: 



(7) 



[0045] The relative roll and pitch gradients Q,^ and 
may be broken into pieces according to the suspension 
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motion and the wheel vertical motion. The roll and the 
pitch gradients Q,x.susp and Qy.susp due to suspension motions 
^ip^rp^ir and ^rr ^lay bs defined as: 



susp 



^'/"''^ (8) 

V.r- jMj/7 ^1 

and the roll and pitch gradients Q,,,^^ Q^, due to 

the wheel vertical motion defined as: 



^y- wh! 



^V-^^^) (9) 

+ 1 

4r 



Then 



Q>' Q>'- SUSP Q^. h-Zj/ 



(10) 



[0046] The relative Euler angles g^j^^ and can be also 
written as two parts: 



3,„.,^Q.w..-^Q (11) 



[0047] Since there are no restrictions in Equation 
(11) , it is valid regardless of if the four wheels of 
the vehicle contact the road surface or lift from the 
road; as soon as the accurate characterization of the 
roll and pitch gradients Q.,.,„,/, and Qy^susp* and Q^.^^^^ and 
Q^_^^^^ are available. Hence in the following 
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Qx^ SUSP f Qy- SUSP , Q,,.y,hi Qy-ww "^^y computed based on the 

available sensor signals. 



Estimate The Roll And Pitch Gradients 

[0048] From the formula in Equation (8) , the roll and 
pitch gradients Q,x.susp and Qy.susp ^^re related to the 
suspension stroke. The estimation schemes are sought 
for computing Q.^.^^^^ and Q^. ^^^^ from the available sensor 
signals . 

[0049] Consider in Equation (3) that the distance 
differences between the left side corners and right side 
corners are equal, that is: 

'If ' ^Ir' ^rr (12) 

or: 

Since the tire deflections are much smaller than the 
suspension stroke, from (13) it is reasonable to say 

^If ' ^rf ^Ir - ^rr (14) 

or rewrite this as: 

(15) 

Hence, for any given constant weight k, we have: 

Q.w..» (16) 
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In the sequential discussion, the Equation (16) may be 
used to describe the roll gradient Q^.susp ■ 

[0050] Qx-susp and Qy-susp tnust then be related to the 
available sensor signals. The following dynamic 

relationship which are obeyed by the car body through 
the Newton law described around the e.g. of the vehicle 
body 

4 

= hyk^^yi + /(V// ^ ^/4> - '(V^ + ^ ^^-4) - KKrSrr + />r*) 

i7«r/- ro//- / ^ flw//- roll' r ^ 

4 

4 

^^s^A^ = a 

/» I 

4 

/= 1 

(17) 

where and ly are the momentum of inertia of the car 
body with respect to the x and y axis respectively; M, 
is the sprung mass (the mass of the car body) ; is the 

eg: height of the car body with respect to the top of 
the suspension; Kj. and Kr are the front and rear 

suspension spring rates with unit N/m. ^anti-rou-f 

^itnti-rou-r Stiff nesses for the front and the rear 

anti-roll bar, with unit Nmlrad. and D, are the 

front and the rear suspension damper rates; F^. is the 

ith suspension force applied to the car body along the 
body fixed direction , and F^,. is the ith suspension 

force applied to the car body along the body fixed 
direction h-^ . 
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Define a weight: 



k = (18) 



ff/ifi- ro//- r 



Since the damping rates are usually proportional to the 
spring rates for suspensions, it is reasonable to 
assume : 



_i ann-roU.f ^ ^^^j 



y-'" For a well balanced vehicle, the normal dead loading 

^jj,. applied to the vehicle should not generate significant 

fil body attitude variation when the vehicle is parked on a 

flat road. That is, the roll and pitch attitude angles 
induced by the normal dead loading during flat road 
parking should be close to zero. For this reason, it is 
reasonable to assume the following holds: 

0; ■ 

W trKr = tj.Kj. (20) 

Similar argument can be used for suspension damping 
rates . 



[0051] Through algebraic manipulation the first two 
equations in Equation (17) can be rewritten as the 
following : 
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+ (/^^ + Danu.roll.ry ^^^^ - + - ^)] (21) 

= h,M,a, + t,K,is,j. + s^^ - - s„)+ t,DA!i^ + sS^- 3^- s^) 

Using the definition of Q.x.smp and Qy.su,p, Equation (21) 
can be rewritten as: 

^ — ^fpy ^\Q.x- SUSP ^■^^x- SUSP (22) 
4 = d^^ + d^Qy^ SUSP + ^2^- SUSP 

that is, Q.v-5i.5/.(0 and Qy.suspiO obeys the l^*" order 
differential equations, and the coefficients CQ,Cy,c2,dQyd^ 
and d^ can be obtained by comparing Equation (21) and 
Equation (22) . Although the analytical solution for 
Equation (22) are not hard to find, the solutions may be 
directly implemented in digital environment . On the 
other hand, the pitch rate signal is not measured, but 
an estimation of the pitch rate signal can be obtained 
as a function of the measured signals and the signals 
computed from the measured signals: 

= ^SQc(q^)-^ w-tan(q^) (23) 

where and 4- estimated global roll and pitch 

Euler angles of the vehicle body (with respect to the 
sea level). The details if this are described in U.S. 
Application 09/967,938 which is incorporated by 
reference herein. Using the estimated pitch rate 
signal, (22) can be used to solve for Q,,.susp(0 and Qy.suspiO 
at time instant t. In the following a digital scheme 
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will be summarized, 
sampling instant: 



Two variables as defined at each 



c, c, 

1 . J (24) 
RPA_RAW{k)^ T^W' -j-^xW 

Then at the {k+l)th sampling instant (current values), 
the estimates of the roll and pitch gradients Qt-ju5p(^+0 
and Qy. may be computed from their values in the 

kth sampling instant (past values) and the current and 
past values of RRA _ RAW and RPA_RAW . The iterative 
formula may be expressed as the following with properly 
chosen coefficients €^,6^,/^ and : 

Q.X- suspik + 1) = eoQ,. ,usp{k) + e,[RRA _RAW{k+ \)^ RRA _ RA Wik)] ^ ^ 

(25) 

Q>- suspik + 1) - foQy. suspik) + AIRPA _RAWik+ \)+ RPA _ RA W(k)] 



[0052] The wheel motion- induced roll and pitch 
gradients are usually much smaller than the suspension 
motion induced gradients due to the small tire 
deflections at each wheel/tire assembly. Therefore: 

Qv- whl Q^- susp / n /r \ 

(26; 

^y- whl '^^ ^ysusp 



or say: 



Q.v Q.r- susp 

Qy- susp 



(27) 
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[0053] As described above, the present invention uses 
Equation (27) to approximately calculate the roll and 
pitch gradients. The relative roll and pitch attitude 
angles can be computed as in Equations (5) and (6) . 

[0054] Referring now to Figure 5, a flow chart 
summarizing the method of the present invention is 
illustrated. In step 70 the sensor signals of the 
sensor set are read. In the present example, a roll 
rate sensor determines the roll rate of the vehicle, a 
lateral acceleration sensor generates a lateral 
acceleration signal of the vehicle body, and a 
longitudinal acceleration sensor generates a 
longitudinal acceleration signal of the vehicle body. 
The yaw rate of the vehicle body is also measured. In 
step 72, a calculated pitch rate signal is determined 
from the yaw rate, the roll rate, the lateral 
acceleration, and the longitudinal acceleration. In 
step 74 the global roll attitude and global pitch 
attitude are determined from the calculated pitch rate, 
the roll rate, the lateral acceleration, and the 
longitudinal acceleration. In step 78 a roll gradient 
is determined based upon a past roll rate and the roll 
rate and the lateral acceleration signal. A relative 
roll angle is determined in step 80 based upon the roll 
gradient. In step 82 a pitch gradient based upon the 
passive raw pitch rate, the calculated pitch rate, and 
the longitudinal acceleration is determined. In step 84 
the relative pitch angle based upon the pitch gradient 
is determined. In step 86 a safety device is activated 
in response to the relative roll angle, the relative 
pitch angle, the global roll angle and the global pitch 
angle . 



24 



[0055] While particular embodiments of the invention 
have been shown and described, numerous variations and 
alternate embodiments will occur to those skilled in the 
art. Accordingly, it is intended that the invention be 
limited only in terms of the appended claims. 
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